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ABSTRACT 


The tracking accuracy of a nussile target seeker depends on many variables. For 
a target seeker using a gimbaled platform, an important variable is the friction induced 
by the preloaded bearings, and by the short wires which connect the target detector 
with the rest of the seeker's electronics. This friction force is nonlinear and sufficiently 
large enough such that accurate position tracking of a target, whether stationary or 
moving, is difficult. Conventional control methods such as P.D. (proportional plus 
derivative) or P.I.D. (proportional plus derivative plus integral) control action can not 
satisfactorily meet the error criteria. To overcome the deficiency of these two methods, 
a model-reference method has been synthesized, relying on idealized predictor corrector 
control to improve the tracking accuracy of the nussile seeker. Computer simulations 
using the Dynamic Simulation Language have demonstrated the superior performance 


expected from this method. 
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I. INTRODUCTION 


A. BACKGROUND 

A typical air-to-air missile seeker might consist of a set of focusing optics, a 
detector, signal processing electronics, gyros, rate and position sensors, all mounted on 
a gimbaled platform as illustrated in Figure 1.1. A missile target seeker's function is to 
detect and to track a target, whether stationary or moving, until the target is 
neutralized. There are many variables which affect the accuracy of the seeker. 
Mechanical variables include friction, inertia, location of center of gravity, and 
vibration. Electrical variables include servos, signal processing limitations, and noise. 
Other variables such as thermal noise, external disturbances, electro-magnetic 
interferences, all play an important role in the tracking accuracy of a missile seeker. 
One of the most important considerations is the effect of friction on the tracking 
accuracy. For a seeker with a gimbaled platform, the friction primarily comes from the 
preloaded bearings and from the wires connecting the platform electronics and the 
seeker electronics located off the platform. This type of friction is nonlinear and its 
direction changes in relation to the motion of the target. Excessive friction causes 
“sticking” behavior and impairs accurate tracking. 

Control of the position of a massive object in the presence of friction is not an 
easy task and requires high positional feedback gain with accompanying high drive 
stiffness for accuracy. Not onlv does this problem arise in target seekers, but also in 
optical tracking telescopes, and robotic manipulators. Classical control techniques for 
accurate tracking have been based on the provision of a drive torque being 
proportional to angular position error with dynamic compensation based on integral 
and, or derivative action. Target position is sensed bv the optical apparatus as an 
angular error from the straight line pointing vector. Platform drive torques are then 
commanded to drive the angular pointing error to zero so that the angular position of 
the gimbaled platform automatically aligns with the target. In stabilizing dynamic 
motions, rate feedback from platform is essentially provided by either the gyros or by a 
resolver mounted opposite the torque motor on the platform. The accuracy of tracking 
is limited bv the sensitivity of the feedback elements and is further impaired by 


vibration and sensor noise [Ref. 1] Normally, high positional feedback gain results in a 


high drive stiffness, but, with the presence of vibration and noise, high stiffness 
increases errors. Modern stabilization techniques are being sought that overcome the 
need for high feedback gains. 

In this thesis, the use of a model based predictor corrector control has been 
demonstrated, including the use of a “stick-slip” friction model for predicting the added 


torque required to compensate for frictional induced inaccuracies. 
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Figure 1.1 Typical Seeker Configuration. 


B. RECENT DEVELOPMENTS IN CONTROL 

A typical method employed to control the position error of a mechanical system is 
the P.D. (proportional plus derivative) action. This control scheme works well in most 
control applications but it has one drawback, the presence of steady state error. 
Integral action is usually added to eliminate the steady state error, but it IS useless in 
the presence of non-linearity elements. Lag lead compensation technique is usually 
emploved to overcome non-linearitv effects bv increasing the gain in the svstem and 
subsequentlv lead to increase noise in the svstem and increase error. 

The use of model-reference controls increased in recent vears. It is found that this 
technique lends itself to the problem of controlling complex and often non-linear 
systems. With the advent of modern microprocessor based controls, techniques using 


model following controls [Ref. 2] offer advantages where a large part oí the control 


force and effect can be predicted, rather that relving on feedback methods alone for 
correction of errors. Model Reference Controls have been used as an ideal response 
generator for comparison with actual system response so that plant parameter changes 
can be monitored, identified, and control gains adjusted automatically. Additionally, 
with particular emphasis on nonlinear systems in robotics, the computed torque 
method and sliding mode control design [Ref. 3] have been proposed for providing 


improved model following and tracking system performance. 


C. OBJECTIVE 

The effectiveness of a target tracker depends on its ability to maintain the target 
within its line of sight regardless of the actions taken by the target. This requires a 
high degree of accuracy on the part of the seeker to response to the motion of the 
target. [t is demonstrated that friction, among other impedimenta. reduces the ability 
of the seeker to track a target. It is the purpose of this investigation to compare 
tracking performance with both classical P.I.D., P.D., and model-reference control 
actions under the assumption of deterministic signals. The primary disturbance is 
considered to arise from friction which 1s modeled here to include coulomb friction and 


the elastic effects from wiring harnesses. 


D. METHOD AND APPROACH 

The approach to this problem begins with a study of the friction variables and 
their effect on the tracking error. Then, the performance of the classical control 
actions, P.D., P.I.D. is evaluated. Finally, a model-reference method has been 
synthesized to improve the tracking accuracy of the seeker. All evaluations were done 
by computer simulation using the Dynamic Simulation Language (D.S.L.) developed 
for the 1.B.M. 3033 computer. The simulation is limited to a single degree of freedom 
ginibal and it is shown that superior tracking accuracy may be achieved using a model- 


reference system with nonlinear friction force compensation. 


Il. ANALYTICAL MODELING 


A. INTRODUCTION 

This chapter discusses the development of the mathematical model for the target 
seeker dynamics in one degree of freedom and the reference model used for nonlinear 
friction compensation. The analytical modeling begins with the derivation of the 
equations of motion for the platform in the Y-Z plane. The motions in the other 
planes are neglected at this time to reduce the level of complexity. Even with this 
simplification, the information obtained in this studv should prove useful in gaining an 
insight to the interaction of friction in a dynamic svstem. A friction model based on a 
“stick-slip” concept Will be developed to model the combined friction effect of the 
bearings and wire harness. This is followed by the presentation of the classical control 
actions. A model-reference method to control the position error will be synthesized to 
improve the tracking accuracy. A brief discussion of the input signal model will 


complete this chapter. 


B. EQUATION OF MOTION 

The platform, together with the optics, detector, gyros, signal processing 
electronics and sensors can be modeled as a simple cylinder with a small degree of out 
of balance. The analvsis begins with the determination of the forces acting on the 
svstem as shown in Figure 2.1. Using Newton’s second law of motion and 


D'Alembert's Principle, the equation of motion of the seeker is derived as, 
a mr”) 9+ F(0.0) + mzr(cos8cosg — sin6sinQ) = ۳ (eqn 2.1) 


where the torque, T_, required to move the platform through an angular displacement, 
0, depends on the position and velocity of the platform and on the motors 
characteristics. The friction term in this equation is nonlinear. It is a function of 6 
and 8 The terms in Z refer to an axial acceleration induced torque arising from some 
small out of balance mass m located at a distance r from the geometric center making 


an angle @ from the Y axis. 


ll 


With a typical d.c. motor, the output torque can be expressed for purposes of 


position control as the sum of proportional error and rate ternis, as, 
T= ۳ e (eqn 2.2) 


where K, is the motor gain constant and A, is the velocity gain constant. For an 
input command, 0. the required torque can be calculated by Equation 2.2 if the 
displacement 8 and velocity 0 of the platform are known. The damping ratio q” 2 is 


used to provide proper damping of the system. 





Figure 2.1 Free Bodv Diagram of the Platform. 


C. FRICTION MODEL 

The main contributors of friction in this platform are the beurings and the 
electrical wires which connect the platform electronics with that located in the support 
structure. A proper friction model must begin with the understanding of how these 
two components behave. The bearing friction 1s basically rolling friction which 1s a 
function of the surface roughness of the races and of the angular speed of the platform. 
The wires act as a spring which could be quite stiff when they are bundled, or soft 
when thev are lose. Relative motion between wires in a harness causes an additional 


friction force that is dependent on the stiffness of the harness. The combined friction 
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dm 


from the two components can be modeled as a massless slider with a spring attached to 


it as shown in Figure 2.2. 





Figure 2.2. Friction Model of the Bearings and Wires. 


The force pulling on the spring stretches the spring bv a distance € until the 
spring's potential force is overcome. Then. the slider begins to move to a distance 0. 
The triction force then is equal to the product of the spring constant and the net 
motion (0 — 0.) of the spring. The spring constant. k, is a function of the coefficient of 
۳۰۰٠ betwcem the der and the surface, Mt. and of the amount of the allowable 
stretch on the spring. 0. A large value for 0 represents a soft spring; and a small value 
for ô represents a stiff spring. When the direction is reversed, the force pushes on the 
spring. compressing it until the force is greater than the spring’s potential force and the 


slider moves in the opposite direction. The friction force of this model 1s given as, 


_ ٤٢-00 
0 


(eqn 2.5) 


When the friction force is less then the triction between the two surfaces, the slider 


does not move until the friction force increases to exceed Jt as indicated in 2.4 and 2.3. 


0 = 0 Би (eqn 2.4) 


F 
0 = 0 – 6 —— = 2.5 
58 ABS(F) LO سد‎ 


In reality, a friction force can exists even though there is no relative motion. A closer 
look at equation 2.3 reveals the ability of this model to support a non-zero friction 
force. When 6. is zero, that is, the platform is not rotating, the friction force is equal 
to the product of the spring constant and @. A typical coulomb friction model would 
have a Zero friction force when 0. is zero. It is the ability of this model to handle 
nonzero friction force which sets it apart from conventional coulomb friction model. 
Once the force exceeds the friction force, the shder starts to move with its direction 
determined by the direction of the force as indicated in Equations 2.5. The response of 


the slider-spring friction model is illustrated in Figure 2.3. 





Figure 2.3 Response of the Friction Model. 


D. BLOCK DIAGRAM OF BASIC CONTROL SYSTEM 

The behavior of the svstem can now be put in a more convenient form for control 
analysis and simulation. A block diagram. is constructed from Equations 2.1 and 2.2. 
Figure 2.4 provides an visual interpretation of the control system which allows more 
effective analvsis of the problem. 
The command signal, 0,, is compared with the position feedback signal, 0, to produce 
an error €. This signal is amplified by a feedforward gain K, in the P.D. control 


method. The amplified signal is compared with the velocity feedback signal to produce 
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Figure 2.4. Block Diagram 
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the required torque to drive the platform. However, this torque is reduced by the 
friction torque caused by the bearings and wires. The torque generated by the out of 
balance mass reduces the available torque even further. What is left is a. greatly 
reduced torque which is not necessarily high enough to drive the platform dynamics to 
the desired position and a position error exists. P.D. control action simply would not 
produce a zero position error. The shortconung of this scheme 1s its lack of history of 
how the error changes with time. The integral action, shown as dotted outlines in 
Figure 2.4, helps to reduce the error by summing errors accumulated up to the most 
recent time, then an amplified average of this error is added to produce the required 
torque. The overall effect is better error reporting and correcting. Ideally, this method 
would produce zero position error. Both the P.D. and P.I.D. control suffer noise 
sensitivity problems. When a noise, either internal or external, is introduced to the 


system it is amplified by the control actions and accurate tracking becomes difficult. 


E. MODEL-REFERENCE CONTROL 
Consider an ideal system which has the same basic inertial characteristics as the 
platform. This is refered to as a model. Assuming the model is perfectly balanced and 


neglecting the effect of friction, the ideal model dynamics is expressed by Equation 2.6. 


Да 
کا‎ 의 eqno 


m 
[f this model is rotated by a motor with the output torque expressed as the sum of a 


positional error and rate feedback, the torque equation is given as, 
Uz G (0 7٤ (eqn 2.7) 


where U is the ideal motor output torque, O, is the command signal as defined before. 
X and X denotes the position and velocity of the model, respectively. G, is the 
positional error gain and G, is the velocity feedback gain. The value of G, is limited 
only by the deliverable torque from the torque motor and G, follows the same 
damping rule as K, but without the problem of signal noise generation. The model 
friction due to the bearings and wires can be modeled as before. Using the notation X 
in place of 09, X in place of 0. M and ó, replace W and 9. the model friction is 


expressed bv Equation 2.8. 


(eqn 2.8) 
m 

57 5:5: (eqn 2.9) 

кк — Бади (ean 2.10) 


ии) 


In order to overcome the friction torque and drive the model to 0. the torque needed 
must be the sum of the two torques described above. The predicted torque is given 


below, 


icd = M (egn 2.11) 
To correct for any positional and velocity errors that might exist between the model 
and the platform, an additional correction torque based on the amplified error signals 
are added to the predicted torque to vield the total required torque, expressed in 


Equation 2.12 as, 


EH Дон AEX O k (x50) (can 77 
Where the second term corrects the positional error and the third term corrects the 
velocity error. 

This software based model is described in Figure 2.5. [t is assumed that the torque 
to drive the platform in following conimmand signals can be expressed as the sum of the 
torque to drive an ideal platform with no friction plus the torque required to overcome 
friction as established by the ideal platform model. Since the actual platform motion 
may differ slightly from that of the ideal, a correction torque is added based on a 


proportional and derivative action applied to motion errors. 


F. INPUT SIGNAL MODEL 

The response of the system to a step input and a sine input is simulated using the 
D.S.L. simulation program. An input command is 0.2 radians for all simulations. This 
is equivalent to commanding the seeker to move 11.459 degrees. The step input is 


roughlv equal to an initial target acquisition phase which the seeker is required to lock 
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On to the target or when the target is stationary. The sinusoidal input simulates the 
maneuvering of the target to avoid lock on. The target is assumed to be moving at 2.5 
Hz. This type of maneuver is extreme because most targets are not able to evade this 
quickly. However, most missiles flex and rotate while moving through the air, which 


makes this assumption more realistic. 
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III. COMPUTER SIMULATION METHOD 


A. INTRODUCTION 

Dynamic Simulation Language (D.S.L. is a FORTRAN-based simulation 
language for simulation of continuous systems. It’s strength lies in its built in 
functions which allow the composition and simulation of any physical systems. Some 
of the built in functions include integrators, function generators, non-linear functions, 
probability distribution functions, and linear transfer functions; allow easy construction 
and simulation of the system without heavv programing. A more comprehensive look 


at the capabilities of D.S.L. can be found in References 4 and 5. 


B. GEOMETRIC DESCRIPTION 

The platform was modeled as an cvlinder two inches in diameter and three and a 
half inches in height. The total mass of the cylinder was 0.0029 slugs plus a 10% out 
of balance mass (0.0003 slugs). The inertia of the cylinder was 0.0037 lb-in-s* The 
initial distance of the out of balance mass from the geometric center was taken to be 
0.1 inches in the positive Y direction and 0.2 inches in the positive Z direction. This 
distance as well as the friction and control parameters were varied to determine their 


effects on the performance of the seeker. 


C. ACCELERATION SIMULATION 
The effect of acceleration is simulated under an assumed flight profile. The 
maximum acceleration subjected to the platform is assumed to be an exponential 


function describes bv Equation 3.1 and 3.2. 


Z 


2۰۱1۰۳۶۰۲۰ ۰ ۲ t « f, (eqn 3.1) 


N 
|| 


7 EXP(— tic.) t» 4t, (eqn 3.2) 


where t, and t, are some arbitrary constants. 


D. DSL CODING 
The flow chart shown in Figure 3.1 illustrates the basic structure of the D.S.L. 


program used in the simulation of the seeker. The program is divided into. segments: 
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|. PARAMETER, INITIAL, DYNAMIC, DERIVATIVE, AND 
TERMINAL. The TITLE segment named the program. The CONST segment defines 
the constants in the program which include the mass properties of the seeker and the 
maximum acceleration. PARAM segment defines the constants which will be changed 
from one simulation run to the next. [t defines the friction characteristics of the seeker 
model, input signals, time constants, gain constants, and the geometry of the out of 
balance mass. The INITIAL segment initializes the variables and calculates the values 
of the out of balance geometry and velocity feedback constant. [he DYNAMIC 
segment calculates the acceleration profile of the seeker and the input signals. This 
segment is computed at each time steps. The DERIVATIVE segment is the main body 
of the program. It consists of the description of the seeker dynamics as well as the 
control actions being used. Finally, the last segment, TERMINAL, contains the 
commands with regard to the total simulation time desired as well as the printing and 
plotting information. 

Appendix A presents the DSL programming codes for the simulation of the 
classical P.D. and P.I.D. control actions and Appendix B presents the DSL 
programming codes for the model-reference control method. The symbol "s" means 


the line is not used for current simulation. 
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Figure 30. 7+7 


IV. SIMULATION RESULTS 


A. INTRODUCTION 

This chapter presents the results of the simulation. The effect of friction, control 
parameters, and control schemes on the tracking accuracy are illustrated bv 
accompanying figures. Except as indicated, all figures shown the command signal, Û, 
as a series of short dashes and the actual response, 0 (TH). as a solid line. The actual 
torque, T, (TX) was indicated as medium length dash lines. Most of the figures reflect 
the response to the sinusoidal input, and also contain the svstem error (THE) as 
indicated by long dash lines. Other information in the figures include the error 
between the response and the slider (THERR). This piece of information indicates 
how the slider from the friction model relates to the response. The pound(1b), inch(in), 
second(sec) svstem was used through out the simulation process. The unit of torque 
was lb-in. The unit of angular displacement was in radians (rad). The velocity and 
acceleration were in rad sec and rad’sec’, respectively. Mass was expressed in lb- 
sec? in. The command signal amplitude was 0.2 radians (11.459 9) and the simulation 


ume lasted one second. 


B. EFFECT OF FRICTION ON ACCURACY 

This section discusses the effect of friction on the system. The system with no 
friction Was simulated and its result was compared with the same system with various 
friction level. In order to provide a meaningful result, all the simulation variables 
except p must remain constant. The control variables K, and Ó were set at 15 lb- 
in rad and 0.05 in, respectively. The value of K, was set at 0.5 Ib-in-sec/rad. Figures 
3.1 through 4.8 are related to this subject. The response of an ideal, balanced, system 
with no friction, to a step input is shown in Figure 4.1 The rise time! of the ideal 
response was 0.12 seconds with no steady state error. Using the P.D. control scheme 
with d equals to 0.1, 0.2, and 0.3, the steady state error increased from 0.00667 to 
0.01333 and to 0.02 radians, respectively. The performance of the P.I.D. control action 


was better. The worst steady state error occured when H equal to 0.3 Ib-in was only 


lThe rise time was taken as the time required for the system to achieve 93% of 
the steady state value. 
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0.00424 radians. However, this better accuracy was at the expense of rise time which 
was 0.24 second. This was twice as slow as in the ideal case. A comparison of 
position error for different friction level at different gain K, was shown in Figure 4.8. 
This figure also shown some interesting information. It was expected the position 
error would increase with increase friction at any given set of circumstances. However, 
the figure indicated that although it was true in general there were cases when an 
increased p did not produce a higher error. For example, when K, equal to 10 lb- 
in. rad the position error for ۳۲ equal to 0.2 lb-in had a higher position error (2.5 mulli- 
radians) compared to 0.84 milli-radians for pm equal to 0.3 lb-in. This was due to the 
nonlinearity of the system. A particular K, combined with a suitable K, and ó would 


produce a better error. 
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C. EFFECT OF THE K I 

The usual method of minimiaing the influence of disturbance forces such as the 
frictional load is to increase the feedback gain, K,, so that system "stiffness" is 
increased. However, while this works with clean signals, the effects of sensor noise 
provides a limit on the useful range of kK. The deliverable torque by the motor also 
hmits the values of K,. Figures 4.9 through 4.14 provide graphical results to different 
К 5. А high K, value drastically reduces the position error of the system as shown in 
Figure 4.8. The steadv state error decreased from 73.88% to 10% when K, increased 
from 2 lb-in rad to 15 lb-in rad. Like wise, the positional error to a sinusoidal input 
decreased from 0.12559 radians to 0.01764 radians when K, increased from 15 Ib-in rad 
to 1000 Ib-in rad. The reponse followed the command signal rather well at the higher 
N, value with a phase shift of less than 0.01 seconds. The torque delivered to the 
system was also higher, an increase of 65%, compared with the lower K, value of 15 
[b-in rad. 


D. EFFECT OF SPRING CONSTANT 

Figures 4.15 through 4.20 shown the effect of spring stiffness to position error. 
The spring constant, 6, appeared to have little effect on the steady state error but it did 
affect the torque delivery to the platform. A very stiff spring, small 6, required more 
torque than a softer spring as expected. Indeed, it was shown in Figures 4.15 and 4.16 
However, this logic did not work in Figure 4.17. The torque delivery in this case was 
higher. The effect on a sinusoidal input was a little different. The stiffer spring 
performed poorer than the softer spring. The maximum error was 0.18527 radians for 
the stiff spring and 0.14129 radians for the softer spring. However, the softer spring 
followed the signal a little better than the stiff spring. The time lag was 0.07 second for 
the stiff spring and 0.04 second for the soft spring. Compares with the ideal case where 
there was no friction, the maximum error was 0.12092 radians with a time lag of 0.04 


seconds as shown in Figure 4.18. 
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E. EFFECT OF INTEGRAL GAIN TIME CONSTANT 

The benefit of an integral action was demonstrated in Section B. This section 
studied the effect of the integral time constant. When the time constant was set to 
unity (Figure 4.5), the response overshot bv 0.00188 radians (0.9495) and then settled 
back to 0.20104 radians at the end of one second. With the time constant increases to 
2 and 3 seconds, the response did not exhibit any overshoot as shown in Figures 4.21 
and 4.22. It did indicate that as the time constant increases, the steady state error also 


increases, even though the increase was small. 


F. EFFECT OFG, 

This section as well as the next section focuses on the control variables G) and y 
prediction on the accuracy of the seeker using the model-reference technique. It was 
shown in previous sections that the sinusoidal input produced an error due to the 
inability of the seeker to track accurately, even in the case where friction was not 
present. This was mainlv due to the inability of the P.D. or P.I.D. control action’s 
failure to correct the inertia effect of the platform in a timely manner. The effect of G, 
was illustrated in Figures 4.23 through 4.25. In Figure 4.23, the maximum error was 
0.09086 radians and a time lag of 0.03 seconds with K, and G, both equal to 30. It is 
interesting to observe that the performance did not degrade even though the value of 
K, was reduced by half provided the value of G, was high. In fact, the performance 
can be improved by increasing G, As shown in Figure 4.24 and 4.25, both the 
maximum error and time lag were drastically reduced to 0.02417 rad and 0.01 rad as G, 
increases to 500 and 3000, respectively. The amount of time lag also cut by a third to 
less than 0.01 second. Although the value of G, was arbitrary, it was not without 


bound. The maximum usable value depends on the size of the torque motor. 
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G. EFFECT OF H PREDICTION ERROR 

The main advantage of the model-reference control scheme is its ability to predict 
the response of the system using an ideal model. Figures 4.26 through 4.29 study the 
sensitivity to an erroneous prediction of the friction level in the system. Friction levels 
of pt equal to 0.1 to 0.5 with an increment of 0.1 were simulated. The results indicated 
that a wrong prediction did make a difference. The maximum errors in order of 
increasing ft were 0.01692, 0.01862, 0.01, 0.01368, and 0.01845. A smaller svstem 
friction than predicted tends to cause overshoot while a larger svstem friction causes 
the response to be a little short. In the sinusoidal input response, the corrective torque 
Was trying to correct the overshoot but it's effectiveness was quite limited. This 
problem can be corrected by adaptive control action. Very often, the model-reference 


action was used with adaptive control. 


H. EFFECT OF UNBALANCED SYSTEM 

The effect of the out-of-balance appeared to be quite minimal as shown in Figures 
4.30 through 4.32. The response typically reached a maximum values early on, usually 
within the first 0.12 seconds, then it droped slowlv as the acceleration. reached 
maximum acceleration. After the platform reached the maximum acceleration and 
started to decelerate, the response rose again. As the distance between the center of 
gravity and the out of balance mass increased, the accuracy decreased. Therefore, It 1s 


important to consider the effect of out-of-balance mass in platform design. 
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I. EFFECT OF ACCELERATION 

The effect of acceleration was similar to that of the C.G. location. The response 
began to drop as the acceleration approached maximum and recovered when the 
platform started to decelerate. This phenomenon was true for both the P.D. and 
model-reference control schemes shown in Figures 4.33 through 4.36 with either step 
input or sinusoidal input. However, the model-reference action allowed a much 
quicker recovery than the P.D. action. This was due to the correction torque provided 
by the model. Furthermore, the P.D. action had a much greater positional error while 


responsed to a step input and a slower response to a sinusoidal input. 
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V. DISCUSSION AND RECOMMENDATION 


A. INTRODUCTION 


This chapter summaries the results obtained from the D.S.L. simulation and make 


recommendations for future work in this area. 


B. DISCUSSION 

[he model-reference control method described here offered better tracking 
accuracy than either the P.D. or P.I.D. actions. It also minimized the problem of 
noisy feedback signals. This software based model utilizes an idealized model as a 
reference to predict the torque needed to overcome friction and gimbal dynamics and 
produce zero position error. First, the amount of torque needed to drive an idealized 
platform with no friction is predicted. Then, the torque required to overcome friction 
is determined from the friction model described in Chapter II. The sum of these two 


produced a predicted torque T In addition, the idealized platform velocity X is 


xpred'. 
compared with the actual velocity Û and the error is amplified. Similarly, the ideal 
position X is compared with the actual position 9 and the error is amplified also. A 


corrective action occurs when these amplified error signals are added to T to vield 


xpred 
the total required torque T,. The result is a highly tuned, high న్‌! control 
action. Since the reference model 1s ideal, it does not have the draw back of large noise 
amplification as the other two control schemes do. Therefore, it is reasonable to 
expect better target tracking, even if the noise level is high. 

The simulation results clearlv shown the superior tracking accuracy provided bv 
the model-reference method. The level of accuracy achieved is adequate for most 
target tracking seekers. Although this study was limited to the Y-Z plane only, this 
exercise did provide a better and clearer understanding of how friction and control 
variables affect the performance of the seeker. Of course, the performance of a mussile 
seeker is affected by many other variables. not discussed here. The effect of vibration 
as the missile moves through the air, or the effect of air blast in the vicinity of the 
missile are examples of disturbance which will play an important role in the tracking 
accuracy of the missile. The friction model presented here is more realistic than simple 
coulomb friction model which produces an underfined friction force when 9, is equal to 


zero. The model presented here does allow non-zero friction force under stationary 
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conditions. Improvements can be made on the model-reference method to have 
adaptive capability to take into consideration the external disturbances, and 


variabilities in actual friction. 


C. RECOMMENDATION 

[t is recommended that an experimental follow up be made to compare with the 
results obtained by analytical means. Frictional effect is not the only element affect 
seeker performance. There are other problem areas which also deserve the attention 
given here; among them vibration, shock, and random noise effects. It will be 
interesting to subject the model-reference control method described here to these 
external disturbances to see how well or how poor the current method handles these 
problem. These disturbances can be incorporated into the model-reference algorithm 
so their effects will be minimal. There are also an abundance of research in adaptive 
control. This type of control action enables a control svstem such as the one described 
here the ability to “learn and adjust” the model to different signal input. This latest 
technique 1s most versatile and would definitely contribute to the tracking accuracy of 


the seeker. 
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APPENDIX A 


DSL LISTINGS (PD, PID CONTROL) 


TITLE GIMBAL DYNAMICS 


AC ke ek kk kk e ck kk o Ak GA‏ کار کار کار 


& AUTHOR: JOSEPH CHAN 

& ABSTRACT: THIS PROGRAM SIMULATES THE MOTION OF A SINGLE 
k GIMBAL SYSTEM WHILE SUBJECTS TO STEP AND SINUSOIDAL 

: EXCITATIONS. PD AND PID CONTROL ACTION. 

—55— ——..- -—----.---..-......-.---..--.s-----.--.---------- 
大 

: SYMBOLS : 

* BM : MASS OF THE CYLINDER. 

* DELTA : CHAR. DISP FOR COULOMB FRICTION MODEL. 

k F : BEARING FRICTION FORCE. 

k IM : MASS MOMENT OF INERTIA OF CYLINDER. 

x K1 : TORQUE GAIN CONSTANT. 

& K2 : VELÓCITY FEEDBACK CONSTANT. 

* NU : COEFFICIENT OF FRICTION. 

* PERIOD : PERIOD OF THE SINE INPUT. 

x PH : ANGLE BETWEEN THE Y-AXIS AND R. 

x R : DISTANCE TO THE OFF-CENTER MASS FROM THE ORIGIN. 
& SM : OUT OF BALANCE MASS. 

& TAUI =: ACCELERATION TIME CONSTANT E PHASE). 

& TAU2 : ACCELERATION TIME CONSTANT (FINAL PHASE). 

x TH : ANGULAR DISPLACEMENT OF THE CYLINDER. 

k THO : INITIAL ANGLE ROTATION. 

* TH2DOT : ANGULAR ACCELERATION. 

* THCOM  : COMMAND ANGLE INPUT. 

x ТНОО : INITIAL ANGULAR VELOCITY. 

x THDOT : ANGULAR VELOCITY. 

* THE : ANGULAR DISPLACEMENT OF THE CYLINDER. 

x THS : POSITION OF THE SLIDER. (FRICTION MODEL) 

& TIME : SIMULATION TIME. 

x TX : MOTOR TORQUE. 

x Y0 : DISTANCE TO OFF CENTER-MASS IN THE Y DIRECTION. 
& 20 : DISTANCE TO OFF CENTER-MASS IN THE 2 DIRECTION. 
x Z2DOT : LINEAR ACCELERATION. 

& ZM : MAXIMUM LINEAR ACCELERATION. 


b> 가 가 가 ہر‎ 가 가 가 가 가 پر ہر ۔پر‎ Y سإ پر پر‎ Y XY XY Y Y پر‎ OE Oc OE OE Oc OR OF Oc OR Ob ob ob T Y స 


HR úR HR NN HÚ جار جا جار جار‎ RN XARXA RA RARA KA A ARA RARA ار ار چر‎ ААХАлАКАХАХАХлКАААлАХАХААХАХАХААХ 


x 


GIMBAL PARAMETERS 


大 


六 文大 太太 大大 大大 大 大 大大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大大 大 大 大 大 大 大 大 太太 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 六 大大 大 六 六 大 


大 


CONST BM=0.00290, SM=0.00030, 21120۰0000 , 1М=0.00370 
LE= S**2/IN LB 780 IN) ٰ ۶ ER 2 


PARAM K1=15.000, MU=0.3, DELTA=0.05, PERIOD-0.4 


LB-IN/RAD IN SEC/CYC 

PARAM YO=0.1, Z0=0.2, TAU1=0.5, TAU2=0.5, THMAX=0.2 
: IN IN SEC SEC RAD 
INITIAL 

R = SORT (YO**2+Z0**2) 

PH - ACOS(YO/R) 

K2 = SORT(8*IM*K1) 

F >00 

TH = 06 

THO OO 
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THDO = 0.0 
THDOT = 0.0 
THE = 0.0 
THEO = 0.0 
THERR = 0.0 
THS = 0.0 
* 
DYNAMIC 
大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 六 大 大 大 大 大 大 大 大 大 大 大 大 大 
A ACCELERATION PROFILE k 


大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 穴 大 大大 大 大 大 大 灾 大 大 大 大 六 大 大 六 大 穴 天 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 
x 
TI = TIME-4.0*TAU1 
Z2DOT = 2M*(1.0-EXP(-TIME/TAU1)) 
IF (TIME.GT.(4.0*TAU1)) THEN 
22008 = ZM*EXP(-T1/TAU2) 
ENDIF 


SINUSOIDAL EXCITATION 
THCOM=THMAX*SIN(2*PI*TIME/ PERIOD ) 

STEP INPUT 

5 THCOM=THMAX 


DERIVATIVE 
NOSORT 


大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 
六 BEARING FRICTION MODEL < 
大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 六 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 
大 


가 가 가가 가 가 가 


THERR = TH-THS 
F = MU*(THERR)/DELTA 
IF (E THS - THS 
IF ((ABS(F)).GT.MU) THS = TH-DELTA*F/ABS(F) 
大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 
k MOTOR TORQUE MODEL k 


جار جار جار جاج جار جار جات جار جار جار جار جار جار جار جار H‏ جار جار جار جار جار جار جار جار جار جار جار جا جار جار جار جار جار جار جار HR H‏ جار جار جار جا جار جار جار جار جار جار جار جار جا ke‏ جار جار جار جار جار جار جار جار جار جار جار جار جار جار جار جار HH H‏ 
大‏ 


R THE = THCOM-TH 

ED" FEEDBACK 

7 TX = K1*(THE)-K2*(THDOT) 

2 ۲۶ 775 
TX >1 0 2۶۷۲ء رم‎ 
TH2DOT = (TX-F-SM*Z2DOT*R*(COS(TH)*COS(PH)-SIN(TH) ... 

ZSIN(PH)))/ (IM 2 

THDOT = INTGRL(THDO,TH2DOT) 
TH - INTGRL(THO,THDOT) 

8 4 = INTGRL(THEO,THE) 

METHOD RK5 


CONTRL FINTIM-1.00, DELT-0.001 


大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 痰 大 大 大 大 大 大 大 大 六 大 大 大 大 大 大 大 大 大 大 大 大 大 


x PRINT RESULTS & 
大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 六 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 


大 


SAVE 0.001, TX, F, THCOM IE, THE ae 
PRINT 0.010, TX, F, THCOM P TU” THE” HELL 


4 THETA VS TIME 
#GRAPH (A,DE=TEK618) TIME(LE=8,UNIT='SEC') TH(LO=-.3,SC=.1,NI=6, ... 
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# UN-'RAD') THCOM(AX=OMIT,LO=-.3,5C=0.1,NI=6,LI=4 UN='RAD!') 
# MARE (NO==. 3, SCS.1,NI=6,LI=2), TX(LI=3, UN='LB- IN" ) 
GRAPH (A,DE=TEK618) TIME(LE=8,UNIT='SEC') TH(LO=0.0,SC=.04,NI=8, 


UN='RAD! ) THCOM(AX- OMIT,LO=0.0,5C=0.04,NI=8,LI=4,UN='RAD') ... 


DI 3, UN='LB-IN' ) 
LABEL (A) MU=0.3, K1=15.0, DELTA=0.05 


- THETA VS TIME WITH THETA COMMAND AS REFERENCE (SINE INPUT) 


#GRAPH (A,DE=TEK618) TIME(LE=8,UNIT='SEC') TH(LO=-0.3, SC= 0.1,NI=6, 
* UN='RAD') THCOM(LO=-0.3, SC=0. 1,NI=6,LI=4, UN= ' RAD 2 


x HYSTERISIS 


#GRAPH 15 Eker. TH(LE=8 , PO=2, 
FLABEL A,B) MU=O.25, K1=2.00, K2= 


0 ISIMESSESDONSE 


#GRAPH 055 TIME(LE=8,UN='SEC') TH(L 
b LI=1,UN='RAD') THS(LO=-.3,5C=.1,NI=6,LI 
# ی‎ UH ho) 

#LABEL (C) TIME HISTORY 


END 
STOP 


4 ,AX=LIN,DRAW,UN=RAD) F(UN='LB') 
0.05, DELTA=0.050 


EoOsss 3 5C-.1,NISO . 


2, UNS RAD'j ... 
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APPENDIX B 
DSL LISTINGS (PC CONTROL) 


TITLE GIMBAL 2 


大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 六 


HHHH HN XM 


AUTHOR: 


ABSTRACT: 


JOSEPH CHAN 
THIS PROGRAM SIMULATES THE MOTION OF A SINGLE 


GIMBAL SYSTEM SUBJECTS TO STEP AND SINUSOIDAL EXCITATIONS 
USING PREDICTION CORRECTION CONTROL ACTION. 


SYMBOLS: 


BM 
DELTA 
DELTAM 


: MASS OF ۹۹٣٣ 

: CHAR. DISP FOR COULONE ERICIIONSMODEES 
: CHAR. DISP FOR COULOMB FRICTION (REFERENCE MODEL). 
; BEARING FRICTION EGR CE. 

: BEARING FRICTION FORCE (REFERENCE MODEL). 

: REFERENCE MODEL ٣٣ھ‎ ٤٣۳ 

: REFERENCE MODEL TRANSFER FUNCTION. 

: MASS MOMENT OF INERTIA OF CYLINDER. 

: TORQUE GAIN CONSTANT. 

: VELOCITY FEEDBACK CONSTANT. 

: COEFFICIENT ۴ ۳/۵ 

: COEFFICIENT OF FRICTION (REFERENCE MODEL). 

: ANGLE BETWEEN THE Y-AXIS AND R. 

: DISTANCE TO IHE OFF-CENTER MASS FROM THE ORIGINS 
: OUT OF BALANCE MASS. 

: ACCELERATION TIME CONSTANT :7:: PHASE). 
: ACCELERATION TIME CONSTANT 

: ANGULAR DISPLACEMENT OF THE CYLINDER. 


FINAL PHASE). 
INITIAL ANGLE ROTATION. 


: ANGULAR ACCELERATION. 
: CONTROL ANGLE INPUT. 


INITIAL ANGULAR VELOCITY. 


: ANGULAR VELOCITY. 

: ANGULAR DISPLACEMENT OF THE CYLINDER. 

: POSITION OF THE SLIDER. (FRICTION MODEL) 

: SIMULATION TIME. 

: MOTOR TORQUE. 

: MOTOR TORQUE (PREDICTED) 

: DISTANCE OF MASS AT ANY TIME T. (FRICTION MODEL) 
: INITIAL DISTANCE OF REFERENCE MODEL. 

: DISTANCE MOVED BY THE SLIDER. (FRICTION MODEL) 
: ACCELERATION OF REFERENCE MODEL. 

: VELOCITY OF REFERENCE MODEL. 

: INITIAL VELOCITY OF REFERENCE MODEL. 

: POSITION OF SLIDER (REFERENCE MODEL). 

: DISTANCE TO OFF CENTER-MASS IN THE Y DIRECTION. 
: DISTANCE TO OFF CENTER-MASS IN THE Z DIRECTICN. 
: LINEAR ACCELERATION. 

: MAXIMUM LINEAR ACCELERATION. 


N NF DF ۔پر‎ ob ob OF OE FOE OE ob OE OE EF OE Ob E OE OE OE OE OE HH T TT T T T T T T 


大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 六 大 大 大 大 大 大 六 大 大 大 


* 


GIMBAL PARAMETERS 


大 


大 类 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 类 大大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 大 天 大 大 


大 


CONST BMz0.00290, 
EEz SAk2/IN 


PARAM K1=150000, 


SM=0.00030, 2M=0.0000,  IM=0.00370 
LBS Sk*2/IN 2 LB-IN-S**2 


MU=0.3, DELTA=0.05, PERIOD=0.4 
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2 LB-IN/RAD IN 2> 
PARAM 212909507 MUM=O.3, DELTAM=0.05, ТНМАХ=0.2 
IN 


: RAD 
PARAM YO=0.1, Z0=0.2, TAU1=0.5, TAU2=0.5 
x IN IN SEC SEC 
六 
INITIAL 

R = 5ОКТ(УО**2420**2) 

РН = ACOS(YO/R) 

K2 = SORT ET 

G2 = SORT(8*IM*G1 

F = 

TH = 0.0 

mon 000 

O ED 

DD 

nE 00 

1090 90٦ 

THERR = 0.0 

THS 0.0 

X MD 

XO EU 

“DOT 0.0 

XDOTO = 0.0 

575-:: 

XS -5: 
x 
DYNAMIC 
Xxxıxxxıxıxxıxxxxxxxxxxxxxxxxxxxxxxkxxxxxxxxxxrrxxkxxxxxıxxxxxxxxıxxıxııxxxxxxxx 
x ACCELERATION PROFILE x 


六 六 六 六 大 大 六 六 太太 六 六 六 大大 大大 六 六 太 大 大大 大 六 六 六 大 大 大 大 大 大 大 大 大 六 大 大 大 大 六 六 六 大 大 六 大 大 大 大 六 大 大 大 大 大 六 大 大 大 大 大 大 大 六 六 六 六 大 
TIME-4.0*TAUI 
2200Т Co A 
IF (TIME.GT.(4.0*TAU1)) THEN 
22DOT = ZM*EXP(-T1/TAUZ) 
ENOTE 


SINUSOIDAL EXCITATION 
THCOM=THMAX*SIN(2*PI*TIME/PERIOD) 
STEP TNPST 
ТНСОМ=ТНМАХ 


DERIVATIVE 
NOSORT 
AX 


KRKKKRKKKKKKKAKKARKKKKKKKKKKKRKREKAKKEKKRKKKKKKKKKRKAKKKKKRKKKRKKKKKKKKRKKKKAKK 


2 MODEL” REFERENCE DYNAMICS 2 
大 六 大 六 大 大 六 大大 六 太太 六 六 大 大 六 大大 大 大大 大 大 六 大 大 大 六 大 六 六 六 六 大 大 大 大 大 大 六 大 大 大 大 大 大大 大大 六 大 大大 六 大 大大 大 大 大 大 大大 大 大 六 六 六 大 


x 


11 


A ہمہ‎ FE ۱۰ 가 가 


U (THCOM-X)*G1-G2*XDOT 
XZDOT U/ CIM+SM“R~*2 ) 

EM MUM/DELTAM* (X-XS) 
TE 177: mü AS = XS 
IE ABS(FM)).GT.MUM) XS = X-DELTAM*FM/ABS (FM) 
۲ TAPRED = U+FM 


k & k 2 k k X k k k K k k k k k k k k k k k k k k k k k k k k k k k k k K k k k k k k k k k k k k K K K k K k k k k k k k k k K k k k جا‎ XK 


* BEARING FRICTION MODEL | 2 4 
xxıxxxxxxıxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxıxxxxxıxxxxxxxxxxıxxxx 


x 


కస = TH-THS 
E z 12777 FS 
BEB 555 LI.MU) THS = 185 
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IF ((ABS(F)).GT.MU) THS = TH-DELTA*F/ABS(F) 


kkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkxk 


5 MOTOR TORQUE MODEL 大 


A {PREDICTOR CORRECTOR METHOD ) 2 
RARARRARA RARA AAA AA RRA RA AA KARA RA A A A A KK A RARA RARA RRA RARA RA RARA A KK kk AA 


大 


THE = THCOM-TH 

TX = CRE Re 2827۶۴7 

IF ) ۰۰۵] ات‎ 0) 1X-55.0 

TH2DOT GP 00 lu 
ےی ۸۰۸۸ 1 ٭*‎ ٤ 


THDOT = INTGRL(THDO,TH2DOT) 

TH = INTGRL(THO,THDOT) 

A = INTGRL(XO, XDOT) 

ADOT = INTGRL(XDOTO,X2DOT) 
METHOD RK5 


CONTRL FINTIM=1.00, DELT=0.0001 


ET I Kk TH و ر رد برد برد برد و‎ TF TY TF HH HH K A kA و ر و و و چان چان پان و و و ر ر ر و ر ر ر ار ر و ر ر ار برد برد چا چاه بر جرد چا‎ I I 
大 PRINT RESULTS 大 
برد جلو جار ماو عل عاو‎ + Z H Z Z HH جاو‎ రోం جاو ار جرد برد‎ రోం Z Z Z AA AA A A AAA جاو جاو جاو جاو جاو جاو حاو جاو‎ Z< مان جاو مان جار‎ Zc Z ke oke Zç Zc Zc Z oke oke e ماو جاو مان جل‎ RA Zc Zc Zç Zc Z جار جاو جاو‎ oke 

* 


SAVE 0.001, TX, TXPRED, క్‌ [| 
PRINT 0.010, TX, TKPRED, E THEO IN THE, THERE 


i THETA VS TIME 


#GRAPH (A,DE=TEK618) TIME(LE=8,UNIT='SEC') TH(LO=-.3,SC=.1,NI=6, ... 

# UNZ'RAD') THCOM(AX=OMIT ,LO=-.3,SC=0.1,NI=6,LI=4,UN='RAD') ... 

3 THERR(LO=-.3,SC=.1,NI=6,LI=2), TX(LI=3) 

GRAPH (A, DE=TEK618) TIME(LE=8,UNIT='SEC') TH(LO=0.0,SC=.04,NI=8, ... 
001 THCOM(AX=OMIT , LO=0.0,SC=0.04,NI=8,LI=4,UN='RAD') . 
TACLI= 

LABEL (A) MU=0.3, K1=1000, DELTA=0.05, MUM=0.3, DELTAM=0.05, G1=1000 


7 THETA VS TIME WITH THETA COMMAND AS REFERENCE (SINE INPUT) 


HGRAPH (A,DE=TEK618) TIME(LE=8,UNIT='SEC') TH(LO=-0.3,SC=0.1,NI=6, ... 
# UN='RAD') THCOM(LO=-0.3,SC=0.1,NI=6,LI=4,UN='RAD') 


大 
j ИҸ̧ӘТЕРТӘТ15 


#GRAPH ии TH(LE=8 
FLABEL A,B) MU=0.25, K1=2.0 


i TIME HISTOR 


#GRAPH TIME(LE=8,UN='SEC') TH(LO=-.3,SC=.1,NI=6, ... 
# LI=1,UN='RAD') THS(LO=-.3,SC=.1,NI=6,LI=2,UN='RAD') ... 

# کت‎ ,LI=4,UN='LB') 

#LABEL (C) TIMÉ HISTORY 


END 
STOP 


2,4,AX=LIN,DRAW,UN=RAD) F(UN='IB!) 
2=0.05, DELTA=0.050 


77 


ts 
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